#ifndef STATEMACHINE_H
#define STATEMACHINE_H

enum State {STRAIGHT_WALL, CORNER, PART_HOLE_FRONT, HOLE, FIND_WALL, PART_WALL_FRONT, PART_WALL_PART_HOLE, 
            TAG_HANDLE, TAG_PROCESSING, START, FIND_FIRST_WALL, WOWOWO, WOWOWO_TURN,
            PATH_STRAIGHT, PATH_LEFT_TURN, PATH_RIGHT_TURN, PATH_U_TURN, PATH_SEARCH_TAG, 
            WOWOWO_PATH};

//WHITE_ORANGE_RIGHT, RED_YELLOW_FRONT, C = Close, F = Far
enum Signal {
	C_C_RIGHT, F_F_RIGHT, C_F_RIGHT, F_C_RIGHT, 
	C_C_FRONT, F_F_FRONT, C_F_FRONT, F_C_FRONT,
	MOTOR_DONE, TAG_DETECTED, TAG_DETECTION_FINISHED, TAG_PROCESSING_FINISHED,
	FOLLOW_PATH_LEFT, FOLLOW_PATH_RIGHT, FOLLOW_PATH_U_TURN, FOLLOW_PATH_STRAIGHT, FOLLOW_PATH_SEARCH_TAG, 
	ACTIVATE1, ACTIVATE2, BUMPER
};

#endif
